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ABSTRACT 


In  this  report,  a  composite  control  scheme  for  the  control  of  robot  manipula¬ 
tors  is  proposed. 

Due  to  the  modeling  error  or  environmental  uncertainties,  robot  motion  may 
present  a  significant  positioning  error  by  using  a  conventional  Computer- Torque 
Method.  To  improve  tracking  capability  of  robot  manipulators,  sliding  mode 
control  and  nonlinear  control  algorithms  have  been  introduced,  but  computation 
is  costly,  and  thus  a  fast  motion  execution  using  simple  computer  sources  is 
impossible. 

To  solve  this  problem,  we  present  a  composite  control  algorithm  to  control 
robot  motion  combining  a  discrete  feedforward  component  and  a  continuous  feed¬ 
back  component.  The  discrete  feedforward  component  provides  a  nominal  torque 
computed  using  the  robot  dynamics  and  compensates  for  dynamic  coupling  be¬ 
tween  the  links.  This  part  can  be  updated  in  a  large  sampling  time,  and  can 
be  computed  off-line  generally,  thus  real  time  computation  is  decreased.  The 
continuous  feedback  control  component  uses  a  structure  of  Variable  Structure 
System  and  provides  a  robust  control  to  disturbances  during  the  sliding  mode. 
This  part  can  be  digitally  implemented  using  a  short  sampling  time,  and  thus 
a  fast  motion  of  a  multi-degree  freedom  robot  manipulator  can  be  executed  by 
using  a  simple  computer,  or  even  a  single  board  computer  with  an  8-bit  CPU. 

The  stability  of  the  proposed  multiple-rate  control  scheme  is  proven  in  the 
paper  and  efficiency  of  the  control  scheme  has  been  demonstrated  by  simulations 
of  a  three-link  robot  subject  to  parameter  and  payload  uncertainties. 


1  Introduction 


The  lack  of  efficient  and  robust  real-time  control  algorithms  for  high  speed  motions  is  one 
of  the  important  recisons  why  the  applications  of  the  present  robotic  manipulators  are  lim¬ 
ited.  The  dynamic  equation  of  robotic  manipulator  is  highly  nonlinear  due  to  the  inertia 
and  strong  coupling  terms  among  the  joints,  such  as  centrifugal,  Coriolis  and  gravitational 
forces  [11,  12].  It  is  difficult  to  guarantee  the  tracking  error  bound  in  high  speed  motion, 
by  neglecting  the  nonlinear  dynamic  terms  which  may  act  as  a  large  disturbance  to  the 
controller.  In  order  to  improve  the  trajectory  tracking  accuracy,  it  is  necessary  to  take  the 
robot  manipulator  dynamics  into  consideration  [12]. 

The  well-known  Computed  Torque  Method  (CTM)  normally  provides  a  feasible  controller 
if  the  exact  knowledge  of  the  manipulator  dynamics  is  available.  However,  for  a  large  amount 
of  applications,  it  is  impossible  to  obtain  the  complete  dynamic  model  of  robots,  due  to 
modeling  uncertainties,  parameter  variation  and  unknown  payloads.  These  uncertainties, 
especially  the  error  of  inertia  matrix,  may  result  in  the  instability  of  robot  systems  [17, 
13].  On  the  other  hand,  the  computation  time  of  such  a  complex  dynamics  also  makes  its 
implementation  impractical  in  some  cases. 

The  sliding  mode  controller  ba^ed  on  the  Variable  Structure  System  (VSS)  method  has 
the  properties  of  rejection  to  disturbance  and  insensitivity  to  parameter  variations.  The 
method  does  not  need  to  have  a  complete  knowledge  of  the  accurate  model,  and  only  knowl¬ 
edge  required  is  the  bounds  of  uncertain  parameters  of  the  system  for  the  design  of  the 
controller  [18].  These  two  features  are  exactly  the  merits  for  the  control  of  a  manipulator 
which  is  subjected  to  the  modeling  uncertainties  and  large  disturbances.  Therefore,  the 
sliding  mode  control  [10,  6,  4,  5]  has  been  proposed  in  many  robot  control  algorithms. 

Depending  on  the  side  of  the  hyperplane  (i.e.,  sliding  surface)  that  the  system  belongs 
to,  the  VSS  is  of  two  structures.  If  the  control  structure  can  be  switched  with  an  ideally 
infinite  frequency,  the  motion  of  the  controlled  system  remains  on  the  sliding  surface.  Then, 
the  system  is  governed  by  dynamics  of  the  sliding  surface  only,  and  the  system  is  insensitive 
to  parameter  variations  and  disturbances.  However,  an  ideal  switching  of  the  input  with 
an  infinite  frequency  is  practically  impossible  due  to  the  switching  delays  and  neglecting 
time  constants.  Instead,  the  control  input  switches  with  a  finite  high  frequency  and  the 
motion  of  the  system  is  within  some  neighborhood  of  the  sliding  surface  with  chattering. 
This  chattering  is  generally  undesirable  in  practice,  since  it  involves  extremely  high  control 
activity  and  thereby  excites  the  high  frequency  dynamics  that  is  neglected  in  the  model. 

To  solve  this  problem,  various  algorithms  have  been  proposed  to  replace  the  discontinuous 
control  in  neighborhood  of  the  sliding  surface  by  the  continuous  control  [6,  4,  5],  such  as 
the  VSS  algorithm,  if  the  trajectory  is  outside  the  boundary  of  the  sliding  surface.  If  the 
trajectory  is  within  the  boundary  of  the  sliding  surface,  however,  a  lot  of  people  suggested  to 
interpolate  the  control  by  proper  continuous  function  to  minimize  the  chattering  caused  by 
a  switching  input.  In  the  implementation  of  these  algorithms  digitally,  we  need  to  compute 
robot  model  and  feedback  of  position  and  velocity  at  every  sampling  time.  In  spite  of 
the  efficient  recursive  dynamic  algorithms  [11,  12,  8]  and  computing  architectures  Ho],  the 
computation  of  the  model  is  relatively  more  costly.  The  time  delay  of  control  input,  due  to 
the  computation  time,  deteriorates  the  performance  in  real-time  control  systems  [9]. 
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To  reduce  the  time  delay  of  control,  it  is  desirable  that  the  feedback  is  not  involved  in 
computation  of  the  model,  and  the  feedforward  compensation  using  the  nominal  torque  is 
good  in  this  sense  [3,  1].  The  adaptive  control  algorithm  with  feedforward  compensation 
provides  a  robust  method  to  control  robot  manipulators.  Actually  there  are  a  lot  papers 
about  the  stability  of  the  adaptive  control.  The  feedback  component  of  the  adaptive  control 
needs  a  considerable  amount  of  computation.  We  believe  that  the  composite  controller  com¬ 
bining  the  discrete  feedforward  and  continuous  feedback  controls  provides  a  good  trajectory 
tracking  performance  in  the  real-time  implementation. 

In  this  paper,  a  composite  control  algorithm  is  proposed  and  the  stability  of  the  system  is 
proven.  The  proposed  algorithm  is  comprised  of  discrete  and  continuous  control  loops.  The 
discrete  feedforward  component  provides  a  nominal  torque  computed  using  robot  dynamics 
and  compensates  for  dynamic  coupling  between  the  links.  This  part  can  be  updated  in  a 
large  sampling  time,  and  can  be  computed  off-line  generally,  thus  a  real  time  computation  is 
infeasible.  The  continuous  feedback  control  component  uses  a  structure  of  Variable  Structure 
System  and  provides  a  robust  control  to  disturbances  of  the  system  during  the  sliding  mode. 
This  part  can  be  digitally  implemented  using  a  short  sampling  time,  and  thus  a  fast  motion 
of  a  multi-degree  freedom  robot  manipulator  can  be  executed  by  using  a  simple  computer, 
or  even  a  single  board  computer  with  an  8-bit  CPU. 

The  rest  of  the  paper  is  organized  as  follows.  In  Section  2,  we  describe  preliminary 
Lemmas  as  a  preparation  for  the  main  control  algorithms.  In  Section  3,  we  present  a  new 
composite  control  algorithm  with  proofs.  In  Section  4,  the  efficiency  of  the  proposed  algo¬ 
rithm  for  the  position  control  is  demonstrated  by  the  simulation  of  a  three  degrees-of-freedom 
manipulator.  The  robust  property  to  the  modeling  errors,  the  time  delay  of  computation,  pa¬ 
rameter  uncertainties  and  payload  variations  is  discussed.  We  conclude  the  paper  in  Section 
5. 
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2  Preliminaries 

The  motion  equations  of  an  n  degree-of-freedom  (d.o.f.)  manipulator  can  be  derived  using 
the  Lagrange-Euler  formulation  as 

D{q{t))q{t)  +  h{q{t),q{t))  =  r(0  (1) 

where  T{t)  €  i?"  is  a  joint  input  torque  vector;  q{t),q{t),q{t)  6  i?"  are  the  generalized 
position,  velocity  and  acceleration  vectors  of  the  joint  angles;  D{q{t))  €  is  a  symmetric 
positive  definite  inertia  matrix,  and  h{q{t),q{t))  €  is  a  nonlinear  coupling  vector  including 
centrifugal,  Coriolis  and  gravitational  forces  [2].  In  the  following,  we  denote  D{q{t))  by  D 
and  h{q{t),q{t))  by  h  for  brevity. 

Let  us  define  the  state  vector  x(<)  €  as 

=  (2) 

Then  the  state  equation  of  the  robot  system  is 

i«)=  0  ^  .-O-'h  + 

Given  the  desired  trajectories  qd{t)iq<iit),qd(i)  €  R”  and  initial  time  to,  we  define  the  sliding 
surface  vector  s(t)  6  as 

s{t)  =  e{t)  +  Kve{t)  +  Kp  f  e{T)dr  (4) 

Jto 

where  e{t)  =  q{t)  —  qd{t)  is  an  error  vector  in  joint  space  and  Ky,Kp  €  are  gain 

matrices.  For  the  use  of  the  following  derivation,  we  introduce  intermediate  trajectories, 
9.(t),9.(t),9.(t)  €  i?",  which  satisfies  the  following  equation 

e(t)  +  Kye{t)  +  Kpe{i)  =  0.  (o) 

Then  we  can  rewrite  (5)  as  follows 

x.(t)  -  i<i(t)  =  A  •  [i.(t)  -  Xd(t)]  (6) 

where  x.(t)  =  [q.{ty ,q.{tYY  €  R^^-,  Xd{t)  =  [qd{t)^ ,  qd{t)^V  ^  ^  ^  ginxin  jg 


Since  det[A/  — A]  =  det[A^/-f- +  /<'p],  we  can  choose  Ky  and  Kp  so  that  all  the  eigenvalues 
of  the  matrix  A  have  negative  real  parts,  which  guarantees  the  exponential  stability  of  the 
system  (6),  and  then  there  exist  >  0  and  k  >  0  such  that 

Ike'll  <5  •e-'“  (S) 
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(9) 


for  alH  >  0  [16].  Here,  the  Euclidean  matrix  norm  of  A  is  defined  as 

||A||  =  [XM(A^A)]i 

where  \m{-)  denotes  the  maximum  eigenvalue  of  a  matrix.  Now,  we  will  state  the  following 
two  Lemmas  as  a  prerequisite  to  the  main  theorems. 

Lemma  1  :  If  the  sliding  surface  defined  by  Equation  (4)  satisfies  ||5(t)||  <  7  for  any 
t  >  to,  then 


\\x{t)  -  i.(t)ll  <  [l|x(to)  -  ar.(^o)||  +  27]  • 
is  satisfied  for  all  t  >  to- 

Proof  :  Using  (4)  and  (6),  we  may  rewrite  (3)  as 

x{t)  —  x.(t)  =  A  ■  [x(t)  —  !.(<)]  4- 
Integrating  both  sides  of  (11)  yields 


0 

i(0 


[x(t)  -  x.(t)]  =  [x(to)  -  a:.(<o)]  -  I  A-  [x(7?)  -  x.{T))]dT]  + 

Jto 


0 

S{t)  -  s{to) 


Taking  the  norm  of  both  sides,  we  get 

||x(<)  -  x.(t)||  <  [\\x{to)  -  x.(to)||  +  27]  +  /  ||A||  •  ||x(r)  -  x.(r)||dr. 

J  to 

If  we  apply  the  Bellman- Gronwall  Inequality  [14]  to  (13),  we  obtain 

lk(0  -  x.(OII  <  [  Wo)  -  x.(M|]  +  27]  • 


(10) 

(11) 

(12) 

(13) 

(14) 


for  all  t  >  to,  and  thus  Lemma  1  is  true. 

If  we  take  x.(to)  =  x(to)  at  the  initial  time,  Equation  (10)  becomes 

||x(<)  -  x.(t)||  <  27  •  (1.5) 

The  above  Lemma  implies  that  the  distance  from  real  trajectory  x{t)  to  the  intermediate 
trajectory  x.{t)  is  bounded  for  a  finite  time.  The  Lemma  2  below  shows  that  the  boundness 
of  the  tracking  error  holds  also  for  an  infinite  time  interval.  Considering  />  as  a  positive 
number  and  vector  u  €  i?",  we  define  the  neighborhood  set  as  follows 


5(p;v)  =  {u;  € /?”;||u;  -  u]]  < /)}.  (16) 

Lemma  2  :  Suppose  |]s(t)||  <  7  is  satisfied  for  all  t  >  to  for  some  to,  and  the  system 
(6)  is  exponentially  stable  and  satisfies  (8).  Then  x{t)  converges  exponentially  into  the  set 
S{e~f,  Xd{t))  with  e  which  is  given  by 


e  -  2  •  (1  -f-  /x)  •  { 


5  ■  (1  +  /^) 


}■ 


(17) 
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where  fi  is  defined  as 


Proof  :  Since  the  intermediate  trajectory  satisfies  (8),  there  exists  T  =  T(a)  <  oc 

T  = 

K 

which  yields 

||x.(<  +  T)-  Xi{t  +  r)||  <  a  •  Ilx.(0  -  x,(<)|| 
for  any  a  €  (0,1)  and  for  all  t.  Define  E{a,^)  as 


E{a,^)  = 


2  . 

13  —  a 


for  any  €  (a,  1).  Now,  if  \\x{to)—Xd{to)\\  >  E{q,  0)-'y  holds  for  some  to,  let  x. (to)  =  x(t3). 
Using  the  triangle  inequality,  we  obtain 

||x(to  +  T)  -  Xdito  +  T)||  <  ||x(to  4-  T)  -  x.(to  +  r)||  +  ||x.(to  +  T)-  Xd{to  +  7^)11.  (22) 

Recalling  the  inequalities  (15)  and  (20),  we  can  rewrite  (22)  as  follows 

||x(<0  +  T)-  Xi{to  +  r)||  <  27  •  +  a  ■  |lx.(^o)  -  Xd{lo)\\ 

2  • 

<  {  +  q}  ■  II _  Xd(t^)|| 

L(a,^) 

=  /3-||x(t„)-Xd(t„)||.  (23) 

Now  if  llx(t)  —  x<i(t)||  >  £(a,/3)  •  7  holds  for  t  =  +  T’,  we  repeat  the  previous  process 

with  the  initial  condition  x.(to  +  T)  =  x{to  +  T)  at  time  t  =  to-\-T .  Then 

||x(t<,  +  2T)  -  Xd{to  +  2r)l|  <  ^  •  ||x(t,  +  r)  -  Xd{io  +  r)|| 

<  •  l|x(to)  -  x<i(to)||-  (24) 

If  this  process  is  repeated  n  times,  we  have 

\\x{to  +  nT)  -  Xd{to  +  nT)\\  < /3’^  ■  \\x{to)  -  Xd{to)\\.  (25) 

Equation  (25)  implies  the  exponential  convergence  of  x(t)  into  the  set  S(£’(q:, /?);  x<i(t)). 

It  remains  to  find  out  the  supremum  of  the  trajectory  errors  for  all  a  and  f3  with  the 
constraint  0  <  a  <  /3  <  1.  Clearly,  the  inflmum  of  E{a,0)  with  respect  to  (3  occurs  as  /3  — > 
1,  and  this  results  in 

2 . 

£:(q,1)  =  — - .  (26) 

We  differentiate  E{a,  1)  with  respect  to  a  and  let  the  derivative  be  equal  to  0,  i.e.. 

dE(a,\)  2{l/s){a/s)-l'^+‘)-{(l  +  M)a-W)  „ 

da  “  '  ' 
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We  can  obtain  the  minimum  of  E{a,  1)  when 


Q  =  a*  = 


MU 


1  + 


MU’ 


and  the  upper  bound  of  the  trajectory  error,  c  =  £'(a*,l),  is  given  by  (17)  and  (IS).  This 
completes  the  proof  of  Lemma  2. 

Note  that  the  equivalent  trajectory  is  only  a  virtual  intermediate  function  between  x(0 
and  Xd{t)  and  does  not  exist  in  a  real  system.  If  ||ar(to)  —  ari(to)||  <  e  •  7  is  satisfied  at  the 
initial  time  t  =  to,  then  the  system  trajectory  satisfies  ||x(t)  —  a:i(t)||  <  e  •  7  for  all  t  >  to. 
In  the  next  section,  we  will  propose  a  controller  which  guarantees  ||5(t)||  <  7,  then  the 
trajectory  error  is  bounded  in  virtue  of  Lemma  2. 
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3  Composite  Control  Algorithm 

To  compute  the  input  torque  using  the  nonlinear  control  algorithms,  we  need  the  dynamic 
model  of  a  robot  system.  For  many  cases  an  exact  model  is  impossible  due  to  the  parameter 
uncertainties  and  payloads  variations.  Therefore,  we  express  the  model  of  the  robot  system 
(1)  as  follows 

Digit))  '  q{t)  +  h{q(t),q{t))  =  r(t)  (2S) 

where  Digit))  ■  qit)  and  ^(q(t)),  q(t))  represent  the  corresponding  terms  of  the  real  system 
(1)  with  modeled  values  of  the  parameters. 

In  general,  we  may  consider  the  control  as  two  parts,  a  feedforw'ard  term  and  a  feedback 


term,  i.e.. 

r(t)  =  Tffit)  +  T^it) 

(29) 

where 

Tffit)  =  biqdit))q^it)  -1-  hiqdit)  3^(0) 

(30) 

and 

Tcit)  =  Diqdit))  •  Ucit) 

(31) 

uM  =  -  K,e(i)  -  k.4t)  -  k 

||5(t)||  -1-  A 

(32) 

The  feedforward  term  and  the  premultiplying  coefficient,  Diqdit))  of  the  feedback 

term  T<.(t)  can  be  computed  in  off-line,  and  thus  are  step  functions  with  time  interval  T)? 
which  is  supposedly  greater  than  the  necessary  computation  time  for  the  model  (28).  In  spite 
of  the  development  of  various  algorithms  and  enhancements  of  computing  architectures,  com¬ 
putation  of  the  model  is  still  costly  and  thus  the  required  time  interval  Tp  is  still  not  small. 
VVe  used  the  notations  qdit),qdit),qdit)  to  denote  the  sampled  values  of  the  correspond¬ 
ing  desired  trajectories  qdit),qdit),qdit)  with  a  sampling  internal  Tp  (i.e.,  qdit)  =  qdikTp), 
qdit)  =  qdikTp),  and  q^H)  =  qdikTp)  JoT  all  t  €  [kTp,ik  +  l)Tp)).  For  brevity,  Diqdit))  is 
denoted  by  Dd  and  hiqdit),qdit))  by  hd  .  If  the  robot  system  (1)  is  controlled  by  the  input 
torque  computed  by  (29)-(32),  we  obtain 

sit)  =  -k,sit)  -  koD-^Dd~)ii^_^  A 
where  the  disturbance  vector,  n(t)  €  i?",  is  given  by 


nit)  =  niqd,qd,qd,q,q) 

=  ^Dit)  ■  -  K^eit)  -  Kpcit)  -  A:,s(0]  +  [Mt)  -  qdit)]  +  •  [hd  -  h] 

and  SDit)  is  defined  ais 

SDit)  =  D-^bd-I. 

We  can  rewrite  (33)  a.s 


sit)  =  -kjsit)  -  ko 


^(0 

KOIl  +  A 


SDit)  ■  sit) 

’lk(0ll  +  A 


-f  nit). 


(34) 

(35) 

(36) 
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Define  the  constants  N  and  M  as  such 


N  =  max{||n(9d,g<f,9<i,2,i«))l;(2(0^>^^(0^]^  ^  ■?(e7; 3;<i(0)}  (37) 

M  =  rnax{||(5D(gd,2)||;z(t)  €  5(c7;  9d(0)}-  (38) 

In  what  follows,  we  prove  the  stability  of  the  system  using  the  controller  given  bv  (29)- 
(32). 

Theorem  1  :  For  a  robotic  system  (1)  using  controller  given  by  (29)-  (32),  if  at  the 
initial  time  t  =  to  for  any  7  >  0, 

||5(i^)||  <  7  ,  Mto)  -  XdiQW  <  e  •  7, 
and  the  gain  ko  is  bounded  by 

N-{l  +  -)<ko<  (39) 

7  M 

for  the  given  /C,  Kp^  k,  and  for  a  small  positive  p,  then  the  system  tracking  error  satisfies 


|•s(^)l|  <  7  ,  a;(0  €  S{er,Xd{t)) 


for  all  t  >  to 


Proof  ;  We  consider  V{t)  =  ^s{t)^s{t)  as  a  Lyapunov  function  and  differentiate  it  with 


respect  to  f, 


°  1|5(<)II  +  a  ^ 


Using  the  matrix  inequality  [7], 


<  ||i|| .  ||i,||  .  IMII 


we  obtain 

f  ^  («) 

If  we  assume  that  x{t)  ^  S{ej;xci{t))  for  some  t  =  t2,  there  exists  ti  €  [^01^2)  such 
that  s{t)  €  5(7)  for  all  t  €  [to,ti)  and  ||s(ti)||  =  7,  since  ||x(to)  -  a:<i(to)||  <  e  •  7  and  the 
motion  trajectory  is  continuous.  Then  z(ti)  €  5(c7;irf(ti))  is  satisfied  (from  Lemma  2),  and 
ll”(ti)l|  <  N  and  ||<5Z?(tj)||  <  M  are  satisfied  from  the  definitions  of  (37)  and  (38).  Hence, 
we  can  rewrite  (43)  as 
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at  t  =  ti-  If  the  gain  kg  satisfies  the  condition  (39),  then 

^(t)  < -p-s(tfs(i)  (45) 

at  i  =  ii,  which  contradicts  the  assumption  that  x(t)  ^  S(ej;  xj(i)).  This  completes  the 
proof  of  Theorem  1. 

If  we  use  a  small  sampling  time  Tp  and  have  a  relatively  accurate  model,  then  the 
maximum  values  of  N  and  M  can  be  small.  In  this  case,  the  lower  bound  of  kg  can  be 
made  to  be  small  and  the  upper  bound  of  kg  can  be  made  to  be  large  enough  to  ensure  the 
existence  of  the  gain  kg.  Since  the  role  of  feedforward  component  T/f(i)  is  compensation 
for  the  dynamics  and  nonlinear  coupling  torques  between  the  joints,  we  may  take  a  large 
sampling  time  Tp  for  the  discrete  terms  Dd  and  hd  to  reduce  the  computation.  Of  course,  the 
sampling  time  should  not  be  too  large.  With  increase  of  the  sampling  time,  the  magnitude 
of  modeling  errors,  ||n(t)||  and  ||6Z)(t)|l  may  become  large,  and  thus  the  required  bounds  of 
the  gain  kg  become  severe  and  the  trajectory  error  is  increased.  This  will  be  discussed  in 
detail  in  Section  4. 

Using  the  smaller  7,  s(i)  remains  closer  to  the  surface  s(t)  =  0  and  the  trajectory  error 
becomes  smaller.  In  this  case,  the  lower  bound  of  the  gain  kg  is  not  necessarily  increased 
since  the  constant  N  of  (37)  is  decreased.  If  we  take  the  smaller  A  in  the  control  algorithm 
(32),  then  both  the  lower  and  upper  bounds  of  the  gain  kg  are  decreased.  However,  it  is 
difficult  to  expect  that  the  control  changes  smoothly. 

In  order  to  achieve  a  smooth  change  of  control  output,  we  may  consider  the  interpolation 
of  the  discrete  terms  Dd  and  hd  in  (30)  and  (31).  Since  these  terms  are  functions  of  the 
desired  trajectories  and  can  be  computed  in  off-line,  the  interpolation  of  these  terms  can  be 
achieved  by  various  simple  methods. 

Substituting  the  continuous  feedback  terms  q{t)  and  q{t)  to  the  sampled  nominal  tra¬ 
jectory  qdit)  and  qd{t),  we  may  get  the  continuous  control  input  in  a  combined  form  as 
follows 

T{t)  =  D{q{t))  •  u{t)  -f  h{q{t),q{t))  (46) 


5  f  ^  ^ 

u{t)  =  qd{t)  -  Kge{t)  -  Kpe{t)  -  fc,s(0  -  [|7(7)||  ^  (4”) 

Then,  we  can  prove  the  boundedness  of  the  tracking  errors  of  the  system  (1)  by  the  controller 
(46)  and  (47)  in  the  same  manner  as  in  Theorem  1. 

If  the  model  is  relatively  accurate  and  the  sampling  time  of  discrete  components  {Tp)  is 
small,  it  is  not  so  severe  to  assume  that  M  <  1.  In  this  case,  we  can  obtain  the  following 
Corollary  which  gives  another  condition  for  kg. 

Corollary  1  :  Consider  the  robot  system  (1)  using  the  controller  given  by  (29)-(32).  If 
M  <  I  and  at  the  initial  time  t  =  tg,  ||s(to)||  <  7  and  ||x(fo)  —  3^d(to)||  <  e  •  7  for  any  7  >  0 
is  satisfied  at  the  initial  time  tg,  and  if  the  gain  kg  is  bounded  by 


7V.(1  +  ^) 
1  -M 


<  kg 


(48) 
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for  given  K^,  Kp  and  positive  k^,  then  the  system  tracking  error  satisfies 


1|5(0II<7,  x(t)  €  5(€7;a:<f(<)) 


(49) 


for  all  t  >  to. 

Proof  :  We  consider  V{t)  =  ^s{t)^s{t)  as  a  Lyapunov  function  and  differentiate  it  with 
respect  to  t, 

^  <  lk(<)l|{||n.(i)ll  -  •  (1  -  ll«C(')lll)  -  k.s(tV^(t).  (50) 

If  we  assume  that  lls(t)||  <  7  for  all  to  <  t  <  ti,  and  l|s(ti)l|  =  7  for  some  ti,  then  it  yields 

f  ^ 

at  t  =  ti.  Hence,  if  the  gain  ko  satisfies  the  condition  (48), 

dV 

—  <  -k,s{tfs{t)  (52) 

a.t  t  =  ti  which  completes  the  proof  of  Corollary  1. 

The  Corollary  1  also  gives  some  insight  of  the  role  of  the  term,  — A:,s(t),  in  the  feedback 
component.  Combining  Theorem  1  and  Corollary  1,  the  sufficient  condition  for  the  stabil¬ 
ity  of  the  system  with  controller  (29)-(32)  is  that  ko  satisfies  the  lower  and  upper  bound 
conditions  given  by  (39),  or  ko  satisfies  the  lower  bound  condition  given  by  (48)  if  M  <  1. 

If  we  eliminate  the  norm  of  s{t)  in  udt),  we  can  compute  Uc,(t)  independently  for  each 
joint  and  the  more  efficient  computation  is  possible.  Thus,  instead  of  using  the  feedback 
control  (32),  we  propose  to  use  the  feedback  component  as  follows, 

Uc(^)  =  -A''„e(<)  -  Kpe{t)  -  k3s{t)  -  ko(T{t)  (.53) 

where 

~  Siit) 

=  ,  <7,(0  =  (54) 

When  the  gain  matrices  Kp  and  Kp  are  diagonal,  we  can  rewrite  (53)  as 

“ci(0  =  -^v.e.(0  -  ^p.ei(0  -  ksSi{t)  -  kocrdt).  (55) 

Using  the  controller  given  by  (29)-(31),  and  (53)  for  the  robot  system  (1),  the  differential 
tracking  error 

i(0  =  -i,s(0  -  ko(T{t)  -  ko  ■  6D{t)a{i)  -f  n(t).  (56) 

where  the  disturbance  vector  n(0  is  given  by  (34),  and  its  i-th  element  is  denoted  by  n,(0. 
The  {i,j)-th  element  of  6D{t)  is  denoted  by  6Dij{t)  and  the  constants  Noo  and  Moo  are 
defined  as  follows 

Noo  =  max{53|n.(gd,9<i,9i,z,u;)|;[z(0^,iy(0^]^  €  Z{er,  Xd{t))}  (57) 


10 


Moo  =  max{^^|(5Aj(9<i,2)|;2(0  G  Z [er.  qd{t))]  (5S) 

«  i 

where  the  neighborhood  set  Z{p\v)  is  defined  below,  for  any  scalar  p  and  vector  v  G 

Z[p\v)  =  {w  e  R'-^Ww  -  v\\oo  <  p]  (59) 

where  ||  •  ||oo  is  the  infinity  norm  of  vector  which  is  the  maximum  of  the  absolute  values  of 
its  elements. 

Now  we  study  stability  of  the  system  using  the  controller  (29)-(31)  and  (53). 

Theorem  2  :  Consider  the  system  (1)  with  controller  given  by  (29)-(31)  and  (53).  If. 
for  any  7  >  0,  ||3(<o)||oo  <  7  ^.nd  x(<o)  G  Z{e-i\Xd{t))  at  the  initial  time  to.  and  the  gain  ko 
satisfies 

Noo  •  (1  +  -)  <  ^o  <  (60) 

1  Moo 

for  the  given  K.u^  Kp,  and  for  an  arbitrary  small  positive  number  p,  then  the  system 
tracking  error 

l|.s(t)||<7,  x{t)  e  Z{e'i;xd{t))  (61) 

for  all  t  >  to. 

Proof  :  Consider  V{i)  =  is(<)^s(t)  a  Lyapunov  function  and  differentiate  it  with 
respect  to  t, 

^(t)  =  s{tfs{t)  =  {5(t)^n(<)  -  -fco5(t)M0}  +  {-kositfSD{t)a{t)  -  kMtfs{t)].  (62) 


Equation  (62)  can  be  rewritten  cis 


dt 


(0  =  Jl5,(t)n,(t)  -koJ2 


Si{t)SDij{t)sj{t) 


(63, 


which  is  bounded  by 


^(0  <  {(E I  I  •  I ".«)  I)  - *.Er^#r!V} 


T  I  ^.(0  I  +A 


+(t.EE'''‘‘’' -  t.Ei  ^.(0  n 


«  } 


<IK0lloo{(El«.(0  l)-*o 


k(0llc 


|5(t)||oo  +  A 


} 


+  "  -  k.]. 

||s(t)lloo  +  A 


(64) 


If  we  assume  that  ||5(t)||oo  >  7  is  true  for  some  t  =  tj,  there  exists  G  [<o,t2)  such  that 
||s(0lloo  ^  7  for  t  G  [<05^i)  and  ||5(ii)|joo  =  7  and  ^(ti)  >  0.  Lemma  2  implies  that 
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x(<i)  €  and  thus  ||n(<i)||  <  Nca  and  ||(5Z)(ii)||  <  Moo  are  satisfied  from  the 

definition  of  Noo  and  Moo-  In  this  ca^e,  we  can  rewrite  (64)  as 


dV 

dt 


(0<NOII=c{A^oc-^ol 


k(OI!c 


I^COIloo  A 


Mo 


l^(01|oo  +  A 


-  k,}  (65) 


at  <  =  <1.  Hence,  when  the  gain  ko  satisfies  the  condition(60),  we  have 

dV 

—it)  <  -p!|5(f)||L  (66) 

a.t  t  =  ti,  and  this  completes  the  proof  of  Theorem  2. 

If  we  assume  A  in  the  feedback  component  (55)  as  to  be  zero,  then  it  takes  the  form  of  the 
sliding  mode  controller.  The  role  of  A  is  to  change  the  discrete  function  to  the  continuous 
function. 

By  substituting  the  sampled  nominal  trajectory  qd{t)  and  qdit)  by  the  feedback  measure¬ 
ment  q{t)  and  q{i)  respectively,  we  obtain  the  continuous  control  input  in  a  combined  form 
as  follows 


r(0  =  D{qit))  ■  u(0  -f  h{q{t),q{t)) 


(67) 


u(0  =  qd{i)  -  Kvt{t)  -  Kpe{t)  -  kss{t)  -  kc,a(t).  (68) 

We  may  also  ecisily  prove  the  boundedness  of  the  tracking  errors  of  the  system  (1)  by  using 
the  above  controller  in  similar  way  to  that  used  in  Theorem  2. 

Provided  that  Moo  <  1  is  satisfied,  the  following  Corollary  gives  a  different  bound  of  the 
gain  kg  from  the  bound  in  Theorem  2. 

Corollary  2  :  Consider  the  system(l)  with  the  controller  given  by  (29)-(31)  and  (53). 
If,  for  any  7  >  0,  ||s(to)||oo  <  7  and  x(to)  €  Z(c7; Xd(<<,))  at  the  initial  time  to,  and  the  gain 
ko  satisfies  the  following  condition  for  the  given  Ky,  Kp,  and  positive  k,, 


^00 -(1  +  ^) 

1-Moo 


<  ko. 


then  the  system  tracking  error  is  bounded  by  7, 


(69) 


l|5(0IU<7,  x{i)  e  Z{€r,Xd{t)) 


(70) 


for  all  t  >  to. 

Proof  :  Consider  V{t)  =  ^s{t)^s{t)  as  a  Lyapunov  function  and  differentiate  it  with 
respect  to  t, 


Si{t)  I  -t-A 


«  ; 
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<  lN(01loo{(l]  I  n,(t)  I)  -  ^[1  -  EE  I  io.,(t)  ID  -  iMtfs(i).  (71) 

Provided  that  ||5(t)||oo  <  7  for  all  t  €  and  ||5(ti)||oo  =  7  for  any  time  ti,  then, 


^(<)  <  ID(l)IU{iV<»  -  -  ^»1)  -  l=.s(tfs(t)  (72) 

at  t  =  ii.  Consider  the  condition  (69), 

dV 

—  (i)  <  -kss(ifs(t)  (73) 

at  t  =  ti.  This  completes  the  proof  of  Corollary  2. 

For  the  digital  implementation  of  the  proposed  algorithm,  the  controller  may  take  the 
multiple-rate  structure,  where  the  sampling  time  Tk  of  the  feedback  component  is  much 
smaller  than  the  sampling  interval  Tp  of  the  feedforward  component.  The  feedback  compo¬ 
nent  Uc{t)  of  (32)  and  (53)  is  simple  in  structure  and  less  computational  time  is  needed.  If  we 
consider  the  gain  matrices  /{'„  and  Kp  to  be  diagonal,  we  may  compute  Uc(t)  for  each  joint 
independently.  When  is  computed  in  off-line,  the  number  of  multiplication  and  addition 
required  to  compute  Tc{t)  is  shown  in  the  Table  I.  The  values  in  the  parentheses  correspond 
to  the  case  n  =  6,  and  the  integral  term  in  the  sliding  vector  is  computed,  as  an  example, 
in  the  following  way. 


int{k)  =  int{k  ~  1)  +  kpe{k)  (74) 

s{k)  =  e{k)  Kye{k)  -1-  int[k),  (75) 

where  s{k)  is  the  value  of  the  sliding  vector  at  the  k-th  sampling  time  (<  =  kTa  ),  and 
int{0)  =  0  and  Kp  =  Ta  •  Kp. 

The  computation  of  the  robot  model  is  132n  multiplications  and  11  In  -  4  additions  where 
n  is  the  number  of  the  degree-of-freedom  of  the  manipulator,  when  the  Recursive  Newton- 
Euler  algorithm  is  used.  In  case  n  =  6,  the  number  of  required  multiplications  is  792  and 
additions  is  662.  Thus  the  feedback  component  is  of  higher  frequency  up  to  40-times  than 
the  feedforward  component. 


Table  I  The  Computational  Cost  Summary  of  Feedback  Control  Comp^onent  Using  the 
Proposed  Algorithms  (The  Numbers  within  Biankets  are  for  the  Case  n-6) 


F— dback  ConSolt 

Th«  Numbar  of  MulSpfication 
(Oiviaion) 

Tba  Numbar  of  Additon 
(Subasction) 

Squat*  Root 

ThMfwn  1 

20  4^6(18) 

2n-i.5(17) 

1 

Thaoram  2 

n^6(12) 

0  4  6(12) 

0 

13 


4  Simulation  Results 


The  purpose  of  the  simulation  is  to  show  the  robust  property  of  the  proposed  algorithms. 
The  simulation  result  is  compared  with  that  using  the  computed  torque  algorithm.  A  three 
degree-of- freedom  manipulator  is  used  as  a  case  study  shown  in  Figure  1. 


Figure  1  A  Three  Oegree-of*Freedom  Manipulator 


The  parameters  are  D  =  0.02l3kg.m,  mi  =  mj  =  0.7S2kg,  and  l\  =  h  =  0.23m.  To 
examine  the  robustness  to  modeling  uncertainties,  the  modeling  errors  of  each  parameter, 
i.e.,  meiss,  length  of  link  and  moment  inertia,  are  considered  to  be  1%.  In  simulation,  the 
payload  of  0  kg.,  0.3  kg.,  or  0.5  kg.  were  carried  by  the  manipulator.  The  execution  time 
'NBS  2  seconds  and  the  desired  trajectory  was 

(9/ino/  ' t  {^final  9inft)  sin(7rt) 

qd{t)  =  qinit  +  - 2 - 2 - ’ 

where  the  initial  position  qinu  =  [0.4,  —0.1,  0.2]^  (rad.),  and  the  final  position  qfinai= 
[-0.1,  0.3,  0.65]^  (rad.). 

In  the  simulation,  the  sampling  time  Ta  of  the  feedback  component  (32)  and  (53)  were 
selected  to  be  1  ms.  The  sampling  time  Tp  of  the  feedforward  component  (30)  can  be  selected 
to  be  much  larger  than  Ta,  due  to  the  rationale  mentioned  previously.  Two  values  of  Tp,  10 
ms  and  50  ms,  is  used  in  simulation,  assuming  that  the  time  required  for  the  computation  of 
the  model  (28),  T^,  is  10  ms.  The  block  diagram  of  the  CTM  and  the  proposed  algorithms 
are  shown  in  Figure  2  and  Figure  3. 
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q^(t) 


Figure  2  Block  Diagram  of  the  Computed  T orque  Method 
{Ky  -20  /,  Kp  -100  I,  T,  -10  ms) 


Figure  3  Block  Diagram  of  the  Proposed  Control  Algorithms 


The  gains  Ky  =  100  •  /,  Kp  =  100  •  /  were  used  in  the  CTM  algorithm,  and  Ky  = 
20-7,  Ki  =  100-/,  ka  —  100,  ko  =10,  7  =  0.1  in  the  feedback  components  (32)  and  (53) 
of  the  proposed  method.  The  simulation  results  of  the  CTM  algorithm  and  the  proposed 
algorithms  are  shown  in  Figure  4,  Figure  5,  and  Figure  6. 
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EmM(D<r~)  EnulDttiM)  i:no<(0.ji».) 


(a)  Joint  1 


Figure  5  Simulation  Results  of  Theorem  1 
(A  :  Load  =  0  kg  and  Tff  =  10ms, 

B  :  Load  =  0.3  kg  and  Tp  =  10ms, 

C  :  Load  =  0.5  kg  and  Tp  =  50ms) 
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(a)  Joint  1 


Figure  6  Simulation  Results  of  Theorem  2 
(A  :  Load  =  0  kg  and  Tp  =  10ms, 

B  :  Load  =  0.3  kg  and  Tp  =  lOms, 

C  :  Load  =  0.5  kg  and  Tp  =  50ms) 
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For  comparison,  the  maximum  absolute  values,  and  the  root-mean-square  values  of  the 
errors  and  torques  are  summarized  in  Table  II. 


Table  II  Simulation  Results  of  the  Proposed  Algorithms 


Algorithm 

Loads 

CTM 

Theorem  1 

Theorem  2 

T^  a  10  ms 

a  50  ms 

Tp  «  10  ms 

Tp  »50ms 

0  Kg 

0.4400 

0.0027 

— 

0.0028 

0.0027 

0.0028 

0.2747 

0.0009 

0.0009 

0.0009 

0.0009 

3.2167 

3.2167 

3.2167 

3.2166 

3.2166 

*rms 

2.0162 

2.0183 

2.0163 

2.C183 

2.0183 

0.3  kg 

8.9651 

0.0683 

0.0683 

0.0661 

0.0660 

•rma 

4.4950 

0.0167 

0.0167 

0.0158 

0.0158 

3.9068 

3.9018 

3.9025 

3.9019 

3.9026 

*rms 

2.5523 

2.5244 

2.5214 

2.5213 

2.5214 

•m 

17.564 

0.1416 

0.1416 

0.1355 

0.1355 

8.6669 

0.0343 

0.0343 

0.0317 

0.0317 

4.3339 

4.4052 

4.4048 

4.4153 

4.4148 

^rms 

2.9106 

2.8600 

2.6600 

2.8600 

2.8600 

« y  :  The  Sum  of  The  Maximum  Absolute  Values  of  The  Three  Joint  Angle  Errors  (Degree) 
0/ms  '  of  The  Root-Mean  Square  Values  of  The  Three  Joint  Angle  Erroers  (Degree) 

r  u  :  The  Sum  of  The  Maximum  Absolute  Values  of  The  Three  Joint  Torques  (N-m) 

*mta  ■  Root-Mean  Square  Values  of  The  Three  Joint  Torques  (N-m) 
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When  the  payload  is  0  kg  and  Tp  =  50  ms,  the  sum  of  the  root-mean-square  values  of 
three  joint  errors  is  0.2747  (degree)  using  the  CTM  algorithm,  while  it  is  0.0009  (degree) 
using  the  proposed  algorithm.  Both  proposed  two  algorithms  presented  better  performances 
than  the  CTM  algorithm  in  the  sense  of  the  tracking  errors.  As  the  payload  increases,  the 
root-inean-square  error  is  rapidly  increased  from  0.2747  (degree)  to  4.4950  (degree)  using  the 
CTM  algorithm,  while  using  the  proposed  algorithms  the  resultant  error  maintains  nearly 
unchanged.  Especially,  note  that  using  the  proposed  algorithm  the  tracking  error  is  not 
increased  so  much  as  the  increase  of  the  payload  error,  for  the  case  Tp  —  50  ms. 

The  simulation  results  have  shown  that  by  the  proposed  algorithms  the  input  torque 
changed  smoothly,  which  is  desirable  in  the  implementation.  When  the  payload  is  0.5  kg 
and  Tp  =  50  ms,  the  sum  of  the  root- mean-square  values  of  the  three  joint  torques  is  4.334 
{N  •  m)  using  the  CTM  algorithm,  while  it  is  4.410  {N  ■  m)  using  the  proposed  algorithm. 
To  compensate  for  the  disturbance  of  the  payload  error,  a  slightly  large  input  torque  is 
necessary.  For  the  proposed  algorithms,  the  input  torques  with  Tp  =  50  ms  are  slightly 
larger  than  that  in  the  case  Tp  =  10  ms. 

From  the  simulations,  we  have  found  that  the  proposed  algorithm  provides  an  e.xcellent 
robust  performance  to  the  disturbance  of  the  modeling  error. 
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5  Conclusions 


In  this  report,  a  composite  control  algorithm  for  the  control  of  robot  manipulators  is  pro¬ 
posed.  The  discrete  component  is  a  nominal  torque  for  the  feedforward  compensation  for 
the  nonlinear  coupling  torques  between  the  links. 

The  feedback  component  uses  the  sliding  mode  control  of  the  Variable  Structure  System 
which  presents  a  stable  performance.  The  proposed  algorithm  does  not  impose  an  additional 
computation  on  the  real-time  implementation,  since  the  computation  of  model  is  necessary 
only  for  the  feedforward  component  which  can  be  computed  off-line.  In  the  digital  implemen¬ 
tation,  the  controller  takes  the  form  of  the  multiple-rate  structure.  The  feedback  controller 
does  not  need  much  computational  time  and  allows  the  short  sampling  time,  and  thus  a 
fast  motion  of  a  multi-degree  freedom  robot  manipulator  can  be  executed  by  using  a  simple 
computer,  or  even  a  single  board  computer  with  an  8-bit  CPU.  .Moreover,  the  time  delay  of 
the  measurement  can  be  negligible,  since  the  measurement  is  utilized  only  in  the  feedback 
component. 

The  simulation  results  have  shown  the  efficiency  of  the  proposed  algorithms  for  the  tra¬ 
jectory  tracking  and  the  robust  property  to  the  modeling  inaccuracy  and  unknown  payloads. 
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